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Abstract 

A  wide  range  of  dynamical  systems  from  fields  as  diverse  as  mechanics,  electrical 
networks  and  molecular  chemistry  can  be  modeled  by  invariant  systems  on  matrix 
Lie  groups.  This  paper  introduces  control  systems  on  matrix  Lie  groups  and  studies 
open-loop  tracking  and  feedback  stabilization  for  these  systems  in  the  presence  of 
nonholonomic  constraints.  Using  the  concept  of  approximate  inversion,  results  for 
drift-free,  left-invariant  systems  on  specific  matrix  Lie  groups  are  presented. 

1  Introduction 

Invariant  systems  on  matrix  Lie  groups  arise  from  a  wide  range  of  fields  encompassing 
problems  as  diverse  as  motion  planning  and  control  for  autonomous  vehicles,  power  con¬ 
version  with  switching  circuits  and  coherent  control  of  molecular  dynamics.  For  instance 
the  kinematics  of  the  orientation  of  an  under-actuated  satellite  or  underwater  vehicle 
can  be  expressed  as  a  system  evolving  on  the  special  orthogonal  group  50(3)  [13],  while 
the  kinematics  of  a  tractor  with  n  trailers  can  be  described  locally  as  a  system  on  a 
certain  subgroup  of  the  unipotent  matrices  (see  [16]  and  our  result  in  Section  3.1).  Some 
electrical  networks  used  for  power  conversion  can  be  modeled  as  evolving  on  the  higher¬ 
dimensional  groups  SO(k)  and  SE(k),  where  the  dimension  k  depends  on  the  complexity 
of  the  network  [25].  Moreover,  so  called  multilevel  systems  used  to  model  molecular  bonds 
in  the  context  of  coherent  control  of  quantum  dynamics  can  naturally  be  represented  as 
invariant  systems  evolving  on  the  complex  unitary  group  U ( n )  [8] . 

Apart  from  the  fact  that  invariant  systems  on  matrix  Lie  groups  arise  naturally  from 
numerous  applications,  our  study  of  these  systems  is  also  motivated  by  more  theoretical 

‘This  research  was  supported  in  parts  by  grants  from  the  National  Science  Foundation’s  Engineer¬ 
ing  Research  Centers  Program:  NSFD  CDR  8803012  and  by  the  Army  Research  Office  under  Smart 
Structures  URI  Contract  No.  DAAL03-92-G0121. 
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aspects.  In  the  analysis  of  nonholonomic  systems  the  Lie  algebra  of  the  vector  fields 
involved  has  turned  out  to  be  the  crucial  characteristic  of  these  systems.  Systems  on 
matrix  Lie  groups  make  this  Lie  algebra  structure  naturally  explicit  and  categorizable. 
Moreover,  they  form  an  important  subclass  of  nonholonomic  systems  since  the  invariance 
of  the  involved  vector  fields  on  the  group  manifold  implies  that  the  corresponding  Lie 
algebras  are  finite  dimensional.  There  are  numerous  mathematical  tools  and  results 
available  for  Lie  groups  and  algebras,  which  can  provide  valuable  geometric  insight  and 
sometimes  elegant  shortcuts.  For  example  the  existence  of  a  smooth,  static  feedback 
globally,  asymptotically  stabilizing  the  origin  of  a  system  on  SO(n )  can  be  precluded 
immediately  since  it  is  shown  in  [24]  that  the  domain  of  attraction  of  an  asymptotically 
stable  equilibrium  point  is  diffeomorphic  to  9?n,  while  it  is  well  known  that  SO(n)  is  not. 
This  global  geometric  fact  might  not  be  apparent  in  a  local  coordinate  representation 
of  the  system.  Of  course  we  have  to  venture  into  local  coordinates  when  we  do  our 
computations  but  we  have  a  range  of  local  representations  at  our  disposal  and  can  work 
with  the  one  most  suitable  for  a  certain  problem  at  hand. 

In  contrast  with  linear  systems  where  the  controllability  Gramian  can  be  used  directly 
to  construct  stabilizing  or  tracking  controls,  to  date  no  methods  exist  to  extract  such 
controls  for  general  nonlinear  systems  from  the  controllability  Lie  algebra.  Focusing  on 
the  class  of  drift-free  affine  system  some  progress  has  been  made  in  this  direction  starting 
in  the  late  80’s  in  the  context  of  nonholonomic  motion  planning  [5,  16].  The  underlying 
principle  here  was  to  make  use  of  oscillatory  controls  which  systematically  “excite”  higher 
order  brackets  of  the  system  to  steer  the  system  in  the  desired  direction.  Leonard  and 
Krishnaprasad  considered  the  problem  in  a  Lie  group  setting  and,  applying  averaging 
theory,  obtained  in  [14]  results  on  approximate  point-to-point  constructive  controls  for 
left-invariant  systems  on  arbitrary  finite-dimensional  Lie  groups.  Sussmann  and  Liu  gave 
a  very  general  result  for  path  constructive  controllability  of  drift-free,  nilpotent  systems 
on  5Rn  [20],  In  parallel  to  these  developments  in  motion  planning,  Coron  [6]  showed  the 
existence  of  time-varying  stabilizing  controls  for  a  general  class  of  drift-free  nonlinear 
systems  while  Pomet  presented  in  [18]  a  method  to  explicitly  construct  these  control 
laws  for  a  more  restrictive  class  of  systems. 

Brockett,  achieved  in  [2,  3,  4]  an  appealing  synthesis  of  the  problems  of  open-loop 
tracking  and  feedback  stabilization  via  the  concept  of  approximate  inversion  of  a  system 
as  captured  in  a  simple,  three  dimensional  nilpotent  system.  After  constructing  controls 
for  asymptotic  tracking  in  the  high  frequency  limit,  the  concatenation  of  the  approximate 
inverse  with  the  original  system  yields  approximately  the  identity  operator  in  the  path 
space  of  the  system.  While  this  is  already  the  solution  for  the  motion  planning  problem, 
the  problem  of  finding  a  stabilizing  controller  is  reduced  to  the  stabilization  of  a  perturbed 
identity  operator  which  can  be  tackled  via  methods  of  robust  control.  Here  we  investigate 
Brockett’s  notion  of  approximate  inversion  in  the  setting  of  systems  on  Lie  groups. 

After  demonstrating  our  tools  in  Section  2,  we  present  in  Section  3  approximate 
tracking  controls  for  a  class  of  nilpotent  systems  and  outline  a  method  to  obtain  ap¬ 
proximate  tracking  controls  for  non-nilpotent  system  using  the  example  of  a  system  on 
SE{ 2).  Section  4  relates  approximate  inversion  to  feedback  stabilization  and  presents  a 
control  law  exponentially  stabilizing  systems  on  three-dimensional  real  matrix  Lie  groups. 


2 


Finally,  we  will  summarize  our  results  in  Section  5  and  discuss  possible  extensions  and 
generalizations. 

2  Preliminaries 

2.1  Lie  Groups  and  Lie  Algebras 

For  general  definitions  and  properties  pertaining  to  Lie  groups,  Lie  algebras  and  the 
exponential  map  we  refer  the  reader  to  the  standard  literature  on  this  topic  such  as  [22,  7]. 
In  this  context  we  will  only  present  the  mathematical  tools  which  relate  specifically  to 
the  problem  of  approximate  inversion  of  systems  on  matrix  Lie  groups. 

2.2  Control  Systems  on  Matrix  Lie  Groups 

In  this  section  we  will  define  the  class  of  systems  we  are  concerned  with,  focusing  for  now 
on  controllable,  drift-free,  left-invariant  systems  on  matrix  Lie  groups.  Generalization 
to  systems  with  drift  and  on  generic  Lie  groups  will  be  discussed  at  a  later  stage  of  this 
work. 

Given  a  real  matrix  Lie  group  G  of  dimension  n  and  the  Lie  algebra  Q  associated 
with  G  having  a  basis  (Ax, . . . ,  An}  of  constant  matrices  in  Q,  let  X  denote  a  curve  in  G. 
Let  U(t),  t  >  0  denote  a  curve  in  an  ra-dimensional  subspace  of  Q  which  can  be  written 
without  loss  of  generality  as  U(t)  =  YZL\Ui{t)Ai,  m  <  n,  where  the  scalar  functions 
Ui(t),t  >  0,  i  =  1, . . .  ,m  are  interpreted  as  controls.  A  drift-free,  left-invariant  system 
on  a  matrix  Lie  group  G  can  then  be  written  as 

X{t)  =  X(t)U(t),  Vf>  0  (1) 

X(0)  =  e, 

where 

m 

U(t )  =  ~^Ui(t)Ai ,  m  <  n. 

i=i 

and  e  is  the  identity  in  G. 

Definitions  and  characterizations  associated  with  systems  on  matrix  Lie  groups,  in 
particular  controllability  and  the  notion  of  a  depth- fc  system,  can  be  found  for  instance 
in  [13]. 


2.3  Exponential  Representations 

The  main  tools  in  our  study  will  be  the  so  called  single  exponential  representation  and 
the  product  of  exponential  representation  for  the  solution  of  (1).  Both  are  in  general  of 
local  nature,  but  have  distinctive  properties  which  make  them  more  or  less  appropriate 
for  specific  problems.  After  introducing  both  representations  and  the  local  equivalents 
of  (1)  in  these  representations,  we  end  this  section  with  a  short  comparison  by  pointing 
out  their  virtues  and  weaknesses. 
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2.3.1  Single  Exponential  Representation 

It  is  well  known  (see  e.g.  [22])  that  the  exponential  map  exp  :  Q  — *  G  is  a  local  diffeo- 
morphism  for  finite-dimensional  Lie  groups  G  on  a  neighborhood  U  C  Q  of  the  origin. 

Moreover,  a  result  by  Lazard  and  Tits  [12]  shows  that  U  can  be  chosen  reasonably 
large  for  the  three-dimensional  matrix  Lie  groups  presented  above.  In  particular,  for 
SE(2),  SO(3),  and  SL( 2)  we  can  choose  U  to  be  an  open  ball  of  radius  7 r,  where  we 
assume  a  standard  Euclidean  norm  on  Q.  For  H( 3)  and  its  higher-dimensional  nilpotent 
generalizations  to  be  presented  below  the  exponential  map  is  actually  a  global  diffeomor- 
phism. 

This  suggests  that  we  locally  represent  the  solution  of  (1)  as 

X(t)  =  exp (Z(t))  =  ez{t\  X{t)  €  exp (U)  C  G,  t  >  0 


with 

Z{t)  =  jTzi(t)Ai, 

i=  1 

and  call  the  Zi,  i  =  1, 2, . . . ,  n  the  canonical  coordinates  of  the  first  kind  for  G.  In  a  similar 
vein  we  write  Z  =  log(X).  This  representation  of  the  solution  to  (1)  was  characterized 
by  Magnus  in  [15].  Adhering  to  our  convention  we  will  present  a  /e/Hnvariant  version  of 
Magnus’  result  without  proof. 

Theorem  1  (Magnus)  Consider  the  left-invariant,  drift-free  system  (1)  on  a  matrix 
Lie  group  G  and  the  single  exponential  representation  Z{t),  t  >  0  of  its  solution.  Then, 
if  certain  unspecified  conditions  of  convergence  are  satisfied,  Z(t )  can  be  written  in  the 
form 

_ _ mt) 

1  -  exp(-adz(t)) 

1  °°  ft 

(/  +  5<xfe(()  +  £  (f^“4p(,))  u(t) 

u(t) + v(t)\  +  i[z(<),  \m ,  (7(t)u  -  im<  [z(<).  y  win  ± . . . , 

where  the  /?2p  are  Bernoulli  numbers. 

Note  that  given  a  /c-step  nilpotent  system  (all  Lie  brackets  of  depth  higher  than  k 
are  zero)  the  in  general  infinite  sum  terminates  and  we  need  only  consider  the  first  k  4- 1 
terms  on  the  right  hand  side.  Moreover,  in  the  general  situation  the  rapidly  decreasing 
coefficients  on  the  right  hand  side  of  (2)  could  be  of  importance  for  approximate  inversion 
of  truncated  versions  of  the  original  system,  which  would  then  solve  the  original  problem 
up  to  a  perturbation  of  small  magnitude. 

Example  1  Using  the  Lie  algebra  structure  of  SE( 2)  as  defined  in  the  Appendix  and  the 
anti-symmetry  of  the  Lie  bracket,  we  obtain  for  the  Magnus  equation  of  the  left-invariant 
system  on  SE( 2)  with  input  U(t)  =  ui(t)Ai  +  u2(t)A2 
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m  =  i'(t)  +  i[z(i),(;(t)]  +  i[2((),W),t'(i)]]±... 

=  U\{t)A\  +  U2(t)A2  +  —  \Z\{t)A\  +  Z2(t)A2  +  Z3(t)A$,  Ui(t)Ai  +  U2(t)A2\ 

+  —  [z\{t)Ax  +  Z2(t)A2  +  Zz{t)A$,  [-Zl(f)Ai  +  Z2(t)A2  +  Z$(t)Az,  U\{t)A\  +  'W.2(^) ^2]]  i  •  •  • 
=  Ui(t)A\  +  U2(t)A2  +  -  (^Zi(t)U2(t)[Ai,  A2]  +  Z2 (t)ui  (t)  [A2 ,  j4i]) 

+^(zi(t)(zi(t)u2(t)  -  Z2(t)u1(t )))  [Ai,A3]  ±  ... 

=  ui(t)Ax  +  U2(t)A2  4-  ^(zx(t)u2{t)  -  z2{t)ui(t)^A3 
^(. Z1(t)z2(t)u1(t )  -  zl(t)u2(t))A2  ±  .  .  .  . 

Due  to  the  linear  independence  of  the  basis  vectors  At,  i  —  1,2,3  this  can  also  be 
written  in  the  standard  state  space  form 

ii  = 

Zl  =  W2  +  —  (ziZ2UX  -  zlu2 )  ±  •  •  • 

4  =  ^(zxu2  -  Z2ux)  ±  .  .  .  . 

Another  single  exponential  representation  relevant  for  approximate  inversion  but  not 
used  in  this  paper  is  the  Fomenko-Chakon  recursive  expansion  [9].  It  can  be  understood  as 
a  continuous  version  of  the  Baker-Campbell-Hausdorff  formula  and  describes  the  solution 
to  (2)  as  an  in  general  infinite  series  of  quadratures  involving  only  U(t). 


2.3.2  Product  of  Exponentials  Representation 

Another  canonical  construction  of  coordinates  for  a  finite-dimensional  Lie  group  G  in¬ 
volves  expanding  X  G  G  in  a  neighborhood  of  the  identity  as  a  product  of  elements  of 
one  parameter  subgroups  corresponding  to  basis  vectors  Ax , . . . ,  An  of  the  Lie  algebra  Q 

X  =  n  eXiAi  =  exlAl  exzA2  •  *  •  eXnAn .  (3) 


The  Xi,  i  =  1, . . . ,  n  are  called  the  canonical  coordinates  of  the  second  kind.  The  product 
of  exponentials  representation  of  (1)  is  characterized  in  [23]  by  the  following  theorem 
where  we  use  an  extended  control  vector  u  =  (ux,..., un)T  with  U{  —  0, i  —  m  + 1, . . . , n. 

Theorem  2  (Wei-Norman)  Consider  the  system  (1)  and  its  solution  X(t),  t  >  0. 
Then,  in  a  neighborhood  of  t  —  0  the  solution  may  be  expressed  in  the  form 

X(t)  —  eXdt)'4l  e*2(tM2  .  .  .  gXnPMn  (4) 
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The  coordinate  functions  Xi(t )  evolve  according  to 


(  Xi (t)  \  /  U\(t )  ^ 

:  =  M(xi, . . .  ,xn)  ■  ,  (5) 

V  Xn(t)  /  \  Un(t )  j 

where  M  is  analytic  in  the  coordinates  X{  and  depends  only  on  the  structure  of  the  Lie 
algebra  Q. 

Moreover,  if  Q  is  solvable,  then  there  exists  a  basis  and  an  ordering  of  this  basis  for 
which  the  representation  (f)  is  global  and  the  Xi  can  be  computed  by  quadratures. 

2.3.3  Comparison  of  Exponential  Representations 

Since  both  exponential  representations  hold  on  neighborhoods  of  the  identity  e  of  G, 
there  exists  a  neighborhood  U  of  e  on  which  both  representations  hold.  Thus  we  are 
free  to  choose  whichever  representation  is  more  appropriate  for  the  problem  at  hand  and 
are  able  to  locally  transform  our  results  from  one  to  the  other.  Moreover,  since  a  metric 
on  the  canonical  coordinates  induces  a  metric  on  a  neighborhood  of  the  identity  of  the 
group  G  our  results  could  be  expressed  locally  directly  for  the  system  (1). 

The  strength  of  the  single  exponential  representation  is  that  the  right  hand  side  of  the 
Magnus  equation  is  structured  as  a  sum  of  Lie  brackets  of  increasing  order  and  therefore 
nicely  reflects  the  Lie  algebra  structure  of  the  system  at  hand.  While  no  conditions  for 
the  domain  of  convergence  of  (2)  are  specified  in  [15],  a  conservative  estimate  is  given  by 
Fomenko  and  Chakon  in  [9]. 

The  advantage  of  the  product  of  exponentials  representation  with  the  Wei-Norman 
equation  (5)  lies  in  the  fact,  that  it  often  leads  to  more  compact  representations  and  that 
we  are  guaranteed  a  global  quadrature  solution  for  solvable  Lie  algebras  Q. 

3  Approximate  Inversion 

Our  approach  to  open-loop  tracking  for  nonholonomic  systems  on  Lie  groups  is  inspired 
by  [2,  3]  and  is  based  on  the  well-known  fact  that  periodic  controls  with  appropriate 
phase  and  frequency  relation  create  a  motion  in  the  direction  of  a  certain  higher  order  Lie 
bracket  of  the  system.  If  we  want  to  move  the  system  in  several  higher  order  Lie  bracket 
directions  simultaneously  we  have  to  additively  superimpose  several  of  these  oscillatory 
control  components,  namely  some  carrier  wave  modulated  by  a  function  specifying  the 
desired  velocity  in  the  corresponding  Lie  bracket  direction.  These  kinds  of  control  laws  are 
evocatively  described  in  [3]  as  “multiplexing”  the  desired  motion,  since  they  accommodate 
the  motions  pertaining  to  different  subspaces  of  the  Lie  algebra  in  distinct  frequency 
bands.  In  this  way  we  can  solve  the  problem  of  having  more  states  to  track  (receivers) 
than  controls  (channels).  It  turns  out  that  if  we  let  the  carrier  frequencies  go  to  infinity 
these  motions  are  increasingly  independent  of  each  other  and  even  though  the  underlying 
system  is  nonlinear  an  approximate  high-frequency  superposition  principle  [20]  emerges. 
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We  are  free  to  use  arbitrarily  shaped  periodic  signals  as  carrier  waves,  e.g.  harmonic 
functions,  square  waves,  etc.,  as  long  as  they  have  a  certain  phase  relation  suitable  to 
“create  area”  in  the  phase  space  of  f  u\  and  /  u^.  In  this  sense  the  approximate  track¬ 
ing  problem  does  not  have  a  unique  solution  unless  we  impose  additional  (optimality) 
conditions  to  make  the  problem  well  posed. 

Modeling  these  open-loop  control  laws  as  time-varying  nonlinear  systems  with  the 
desired  trajectories  as  inputs  we  obtain  the  so  called  approximate  inverse  of  the  original 
system.  This  terminology  is  motivated  by  the  fact,  that  concatenating  the  approximate 
inverse  and  the  original  system  results  in  an  approximate  identity  operator  on  the  space 
of  trajectories.  We  will  see  in  Section  4  that  this  idea  has  interesting  consequences  for 
feedback  stabilization  of  nonholonomic  systems. 


3.1  Approximate  Inversion  on  a  Subgroup  of  Unipot ent  Matri¬ 
ces 


In  this  section  we  will  introduce  a  subgroup  of  unipotent  matrices  which  is  of  particular 
interest  due  to  its  simple  Lie  algebra  structure.  A  two-input  system  of  the  form  (1)  on 
this  matrix  group  will  turn  out  to  be  equivalent  to  a  so  called  chained-form  system.  The 
practical  relevance  of  the  two-input  chained-form  system  (10)  stems  from  the  fact  that 
the  kinematic  model  of  a  car  or  a  tractor  and  trailer  can  locally  be  transformed  into  (10), 
as  is  shown  in  [16]. 

Consider  a  k-dimensional  subgroup  G  of  the  unipotent  matrices  consisting  of  elements 
X  of  the  form 


(l 


X  = 


V  o 


^3 

Xi 

x5 

xk 

Xi 

It2 

2xl 

ir3  ••• 
6X1 

1  x‘ 

(k- 2)!x 

1 

X\ 

1~2 

2X1 

1 

Xi 

1-3 

6X1 

1 

IT2 

2Xl 

*  , 

Xl 

o  i  ) 


X  =  (x1,...,xk)T  <E  $Rfc,  (6) 


which  we  call  SUP(k )  for  future  reference.  Note,  that  for  k  =  3  SUP(k)  is  isomorphic 
to  the  real  Heisenberg  group  3). 

Fix  the  following  basis  for  the  Lie  algebra  of  SUP{k )  : 


1 

/  0  0  0  •••  0  \ 

i  i 

/  0  1  0  • 

••  0  \ 

II 

0  0  1  : 

:  0 

II 

<N 

...  o 

...  O 

1 

\0  •••  0  ) 

\  o 

. 
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A3  — 

/  0  0 

0 

1  0  •••  0  \ 
0 

II 

/  0  •' 

'•  0  1  \ 
0 

lo 

0  j 

0  / 

This  choice  of  a  basis  results  in  the  following  non-zero  brackets 

adJ\1A2  =  —A3 

ad\1A2  =  A4  (8) 

adkA~2A2  =  (~l)k~2Ak. 

Thus  SUP{k )  is  nilpotent  of  order  k  —  2. 

We  would  like  to  solve  the  approximate  tracking  problem  for  the  two-input  drift-free 
system 

X  =  X(uiA\  +  U2A2)  (9) 

where  X  £  SUP(k)  and  A\,  A2  are  defined  as  above.  It  follows  from  (8)  that  (9)  is 
controllable,  more  specifically,  that  (9)  is  a  depth- (A;  —  2)  system  (see  e.g.  [13]). 

Plugging  (4)  into  (9),  differentiating  on  both  sides  and  using  the  Lie  algebra  structure 
of  SUP(k)  yields  the  product  of  exponentials  representation  of  (9): 


±1  =  U\ 

&2  =  u2 
x 3  =  uxx2 

X4  -  U1X3 

xk  —  U\Xk—\ 


(10) 


This  representation  and  the  following  result  hold  globally  by  Theorem  2  since  SUP(k) 
is  solvable.  Note  that  we  could  have  derived  (10)  also  by  directly  writing  (9)  in  its  natural 
coordinates  Xi,...,xk  taken  from  (6). 

Due  to  its  lower  triangular  structure  we  can  integrate  (10)  by  quadratures  and  the 
solution  for  the  nth  state  can  be  written  as 

ft  fTl  fTn- 3  fTn- 2 

xn(t)=  «i(ti)  /  tti(r2).../  Ui{rn_2 )  tt2(r„_i)drn_i  •  •  •  dn,  (11) 

Jo  Jo  Jo  Jo 

assuming  x(0)  =  0.  The  succession  of  integrations  and  multiplications  with  u4  in  (11) 
suggests  to  use  oscillating  control  components  in  w2  with  integrally  distributed  frequencies 
which  are  “down- modulated”  by  multiplications  with  the  fundamental  harmonic  in  u4, 
so  that  this  oscillatory  component  in  Xi- 1  “resonates”  at  state  X{  with  the  cosine  in  U\. 
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Theorem  3  Given  a  (n+2)- dimensional  chained-form  system  (10),  letxit)  =  (5i (t),x2(t), 
. . .  ,5n+2(t))T,  t  €  [0,T]  denote  the  desired  trajectory.  Assume  that  x  is  twice  differ¬ 
entiable  on  [0,T]  and  that  #(0)  =  5(0)  =  5(0)  =  0.  Define  a  sequence  {u^}^  of 
controls 

=  xfft)  +  2 cos(u it) 

/  \  ^  rYY)  I 

4"  =  *2(t)+  £  am(t)u-^ —  —(cos(mujt)),  (12) 

m=l 

where 

—  3'm+ 2(0  3'l(fi)3'm+l(t'). 

Let  x^(t),  0  <  t  <  T  be  the  solution  of  (10)  with  as  input.  Then 

lim  x^w\t)  =  x(t),  Vt  e  [0,  T]  (13) 

U)— *oo  1  J 

where  the  convergence  is  uniform  with  respect  to  t. 


Proof:  We  start  by  proving  a  lemma  which  enables  us  to  discard  terms  in  the  solution 
of  (10)  which  vanish  in  the  high-frequency  limit. 

Lemma  1  Let  f  be  of  bounded  variation  on  [a,  b]  and  let  (j)  6  [0, 27r] .  Then  as  u  — ►  00 

rb 

/  f(t)  cos  (cut  +  (f)dt  =  o(l/u).  (14) 

J  a 

Proof:  (Lemma  1  )  By  the  Jordan  Decomposition  Theorem  we  can  write  a  function  / 
of  bounded  variation  as  the  difference  of  two  non-decreasing  functions  and  therefore  it 
suffices  to  show  the  lemma  for  non-decreasing  functions. 

Now,  assuming  /  to  be  non-negative  and  non-decreasing  and  g  continuous,  it  follows 
from  a  Bonnet  form  of  the  Second  Mean  Value  Theorem  that  there  exists  a  £  €  [a,  b] 
such  that 

/  f(t)g(t)dt  =  f(b)  [  g(t)dt 

J  a 

Hence,  there  exists  a  £  e  [a,  b\  such  that 


/  (t )  cos  (tot  +  (jj)  dt  |  = 


< 


fb 

|/(6)  /  cos  (cut  +  <f>)dt\ 

2/W  ^ 

> 

LU 


and  (14)  follows  from  the  boundedness  of  /  on  [a,  6].  □ 

Note  that  we  can  readily  apply  Lemma  1  in  our  context  since  the  smoothness  as¬ 
sumption  on  x  implies  that  the  5*,  i  =  1, 2, . . . ,  n  +  2  are  of  bounded  variation. 
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We  proceed  to  show  convergence  x\w\t)  — >  Xi(t),  1  <  i  <  n  +  2  for  ui  — *  oo  ,  which 
implies  the  convergence  x^\t)  — ■>  x(t)  with  respect  to  the  standard  norm  on  5Rn+2. 
Writing  out  the  solution  for  the  first  state 


£i(0)  +  J  Ui\r)dr 

pt  n 

/  aq(T)  +  2u)"!+I  cos(coT)dT 
Jo 

xi(t )  +  2uU«+T  sin(u)f), 


it  follows  that 


lim  x^U)  =  oq(t),  Vf  6  [0, T], 

LJ— tOO 

where  the  convergence  is  uniform  with  respect  to  t. 

Using  integration  by  parts  we  have  for  the  second  state 

x(f\t)  =  a2(0)  +  [  u^\r)dT 
Jo 

=  J  *2 (r)  +  Z  am(r)  uT^  — ■  -£-(cos{mur))di 

u  m= 1 


mm  dr7 

n  ml 

=  *2 (t)  +  Z  —  — T(cos (mwt)) 

m= 1 


■E/>™W 

m=l 


_rnn_  ml  d™  1  .  ,  .. 

u>  "+1 - —  _  (cos (mut)), 


mrn  dtm- 1 


(15) 


where  the  first  sum  is  of  order  u>  "+1  and  the  second  sum  is  of  order  ui  ^1+"+1^  by  Lemma 
1.  Thus 


lim  xi ?\t)  =  x2(t),  Vt  E  [0,  T], 

UJ—>  OO 


(16) 


where  the  convergence  is  uniform  with  respect  to  t. 

In  writing  down  the  solution  for  the  third  state  it  will  become  clear  how  the  successive 
multiplications  with  u\  and  subsequent  integrations  required  to  solve  (10)  affect  the  limit 
behavior  of  the  involved  terms.  Plugging  in  for  »i(r),  using  the  identities 


cos(a;£)  cos(na;t)  =  ^(cos((n  —  l)a ;f)  +  cos((n  +  l)a>t)), 


(17) 


2  cos (ut)  Z  ^  J^(cos(mu,r))  =  Z  J~Z (cos((m-l)ur)+cos((m+l)ujT))) 


mm  drm 

and  integrating  by  parts  we  obtain: 


4"’W 

=  ^3(0)  +  J  u^\t)  x^\r)dr 
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ml  d m~1 


=  /  (*iOO  +  2w"+>  cos(ar))  (ar2(r)  +  E  am(T)  ^  "+"  -^L  j——(COs (mar)) 
4-o(a;_^1+"+r^ ))  dr 

=  x2(r)  +  ii(r)ai(r) io~^  cos(a ;t) 

+2  cos(air)  +  ai(r)  +  ai(r)  cos(2a jt) 

n  |  Jm— 1 

+  (^i(r)  +  2w^  cos(a;r))  (  E  am(r)uT^  —  __-(cos(mwr)) 


m=2 


+o(a»  (1+"+^) )  jdr 

=  f  cos(ut) +  2u^x2(t)cos(lot)  +  ai(r)  cos(2lut) 

J  o 

71  (777  _  1 V  /7m_1 

+  E  Qm(T)  faT^  ^  _  !^i  — —  (cos((m  -  l)a it)  +  cos((m  +  l)a;r)) 
+2a;"+i  cos(a;r)  o(a;~^1+"+r^) 


n  ^1  Jm- 1 

+^i(T)(  E  <*m(r)u;-^T  —  ^zi(cos(mu;T))  +  o(w_(1+^}))}dr 

771=1 


=  rr3(f)  +  2  a;  "+1  z2(f)  sin  (ait) 

A  _j«n.  (m  -  1)!  dm~2  .  ..  .  v » 

+  E  M*) w  "+1  /  ~  iw-T  (cos((m  -  l)wt)  +  cos((m  +  l)at)) 

771=2  V '  X  / 

~  I  {  E  am(r)a;-^  ^  j^(cos((m  -  1)<jt)  +  cos((m  +  l)a )r))}dr 
,-1 


+o(a»_1) 

=  x3(t)  +  o(ai_;:+i) 

Again  as  a  consequence  of  Lemma  1  all  terms  in  the  expression  for  a;3(f)  except  for 
a;3(f)  are  of  negative  order  with  respect  to  o>  and  therefore 


=  rr3(t),  Vte[0,T],  (18) 

where  convergence  is  again  uniform  with  respect  to  t. 

To  establish  an  induction  argument  assume  for  the  states  Xj,j  =  4, . . . ,  n  recall  that 
for  *  =  1, ... ,n  —  2 


Xi+2(t)  =  f  «i(ti)  f  ui(t2)...[  ui(Ti)  f  u2(Ti+i)dTi+1  ■  -  •  dru  (19) 
Jo  Jo  Jo  Jo 

i.e.  Xi+ 2  is  obtained  by  applying  an  iteration  to  u2  consisting  of  integration  and  multi¬ 
plication  with  Tti.  According  to  (17)  the  terms  of  u2  are  iteratively  frequency  shifted  by 
±o>  for  each  multiplication  with  the  2  cos(u>f)-terms  of  u\.  We  write 


x 


i+W)  =  Xi+2  4-  J2  {oim(t)u~^ 


ftn-on  (m  -  i)l  dm~i+1 


m=i+ 1 
1 


(m  -  i)m-*  dtm~i+1 


(cos  ((m  —  i)a>f))} 


+2a>  »+i  xi+i(t)  sin(aif)  +  pi+2  +  o{u  *), 


(20) 
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where  the  summation  in  (20)  is  comprised  of  the  terms  whose  frequencies  have  been 
shifted  by  —  u>  for  all  previous  multiplications  with  2a;"+i  cos(cot).  The  terms  whose  fre¬ 
quencies  have  been  shifted  at  least  once  by  +u>  due  to  multiplication  with  2w"+>  cos (ut) 
are  subsumed  under  pi+2.  The  terms  in  pi+2  are  of  lower  order  in  to  as  compared  to 
terms  in  the  summation  with  the  same  frequency.  It  can  be  verified  that  therefore  the 
contributions  of  pi+2  to  the  states  Xj ,  j  =  i+3, . . .  ,n  vanishes  in  the  high-frequency  limit. 
We  assume  further  that  pi+2  =  o(6j"+i)  such  that  lim^,*, x^\ (t)  =  xi+2(t),  \ft  G  [0, T]. 
Note  that  x 3{t)  is  of  the  form  (20). 

The  following  state  can  be  written  as 


sS+sC *) 

rt 

=  /  Ui{T)Xi+2(T)dT 

Jo 

=  J  ^i(r)  +  2  W"+r  cos(o>r))  (xi+2(r)  +  Xi+i(r)  sin(o;r) 

^  .  -("»-»)«  (m  —  *)!  dm~t+1  .  .  .  ,.\ 

+  JC  »+*  ____(cos((m  —  z)u>r))  +Pi+2  +  o(u>  ))  dr 

=  Jo  {5i(r)xi+2(r)  +  «i(r)(ar<+2(r)  -  xi+2 (r)) 

+2a>^+Txi+.2(r)  cos(o;r)  +  2^;^  xi+i(r)sin(iOT)  +  cq+i  (r)  +  ai+i(r)  cos(2a;r) 

-(m-i-l)n  (m  —  i—  1)!  dm~l+ 1  ,,  v  •  -i\  \\ 

+  Jl+*rn{T)u  -+1  — — Ty— T  ^  (cos((m  -  *  -  l)a^)  +  cos((m  -  •  +  l)wr)) 

+2  cos(ur)(pi+2  +  o(w_1))}dr 
=  xi+3  (t)  +  2  xi+2  (r)  sin(wr) 

,  .  -(m-»-l)n  ( 171  —  i  —  1)!  dm  *  ,  ,  ,  .  .  ,,  •  1  \  .\ 

+  £  am(t)u  »+i  ^  p— T  (cos ((m  - 1  -  1 V*)  +  cos((m  -  t  +  1 M) 

m=i+2  '  ' 


+  J  {xi(T)(xi+2(T)  -  xi+2(r)) 


™  -(m-i-l)n  (m-i  -  1)!  dm  1  .  ..  .  .  , ,  .  . .  , 

-  £  am{r)u  -+i  7-——  — y  (cos((m  -  »  -  l)ur)  +  cos((m  -  t  +  l)ur) 

m=i+ 2  ' 


+2w»+i  cos(a>T))(pi+2  +  o(ui  1))}dr 


—  fm  — t— l)n  (m  —  z—  1)!  dm  1 


=  *i+3(*)+  £  M*)"  (to-_  •  z iprr  dF^(cos((m ~ « ~ 1)^)) 


+2o;”+iXi+2(r)  sin(o>r)  -I-  pi+3  +  o(u>  :) 

Note  that  also  here  the  contributions  of  pt+3  and  the  o(u~1)  to  xj,j  =  i  +  4,  n  vanish  in 
the  high-frequency  limit.  Again,  we  have 
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=  j™  (*i+sW  +  <>(«  *«)) 

=  xi+z (t),  vt  e  [0,  T] 


where  the  convergence  is  uniform  in  t.  Our  claim  follows  by  induction  on  i. 

Remarks: 


□ 


•  Since  the  above  convergence  is  uniform  in  t,  also  the  tracking  error,  for  instance 
defined  as  E  =  /0r  ||5(r)  —  a;^(r)||  dr,  goes  to  zero  with  u  — *  oo. 

•  The  residual  terms  are  of  order  —  in  u.  Hence  the  convergence  properties  w.r.t. 
the  frequency  parameter  u  worsen  with  increasing  dimension  n  +  2  of  the  chained 
form  system. 

•  We  have  assumed  a;(0)  =  5(0)  =  5(0)  =  0  so  that  we  can  discard  the  initial 
conditions  and  evaluations  of  the  lower  limit  of  any  definite  integral  in  the  proof. 
Nevertheless,  Theorem  3  holds  whenever  x(0)  =  5(0)  and  5(0)  =  0.  If  we  relax 
5(0)  =  0,  we  have  to  take  care  that  x(0)  cancels  the  evaluations  of  the  lower  limits 
of  integrals  in  order  to  avoid  off-sets  of  the  modulated  cosine  functions  that  are 
added  to  the  state. 

•  The  approximate  tracking  controls  U\  and  u2  given  in  the  theorem  above  are  simpler 
than  if  they  had  been  derived  directly  via  the  more  general  method  of  [20].  Here, 
we  need  only  one  frequency  mu  for  each  Lie  bracket  rather  than  a  whole  set  of 
frequencies.  This  is  possible  because  of  the  exceptionally  simple  Lie  algebra  struc¬ 
ture  encountered  here,  specifically  since  only  brackets  involving  the  A\  direction 
are  non-zero. 


3.2  Approximate  Tracking  on  SE( 2) 

Below  we  will  present  approximate  tracking  controls  for  the  system  (1)  on  G  =  SE( 2) 
which  is  remarkable  since  SE(2)  is  not  nilpotent  as  are  H( 3)  or  the  matrix  groups 
mentioned  in  Section  3.1.  Since  the  controls  involve  feedback  they  do  not  directly  define 
an  approximate  inverse  for  the  given  system  (see  remark  below).  We  will  state  the 
theorem  for  the  Wei-Norman  representation  of  (1),  where  it  follows  from  the  solvability 
of  SE( 2)  and  Theorem  2  that  this  result  is  globally  valid. 

Theorem  4  Consider  the  drift-free  controllable  system  (1)  on  G  =  SE( 2)  with  associ¬ 
ated  Wei-Norman  representation 

l  ii  (t)  =  «i(t) 

52(£)  =  u2(t)  +  ui(t)x3(t)  (21) 

i3(f)  =  -ui(t)x2(t) 
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and  a  twice  differentiable  desired  trajectory  x(t)  =  (xfft),  x2(t),  x3(t))T ,  t  G  [0,  T],  such 
that  5(0)  —  5(0)  =  x(0)  =  0.  Define  the  parameterized  family  of  controls 


ufi\t)  =  xfft)  +  2o;2  cos(u;£)  (22) 

U2*\t)  —  x2(t)  —  u^a(t)  sin  (cot)  —  uf\t)x3(t) 

with  aft)  —  —  xfft)  —  xi(t)x2(t))  and  letx^(t),t  >  0  be  the  solution  of  (21)  with  controls 
Ui>\t),u2‘\t)  as  input.  Then 

lim  x^\t)  =  x(t),  V£  G  [0,  T], 

(Jj— »oo  v  v  '  L  J 


uniformly  in  t. 

Proof:  Rewrite  the  controls  u(t )  =  (ui(t)u2(t))T  as  u(t )  =  H(x(t))v(t)  with 

“  ( -4)  i ) 

(  Vi(t)  \  _  /  5i(t)  +  2a;  2  cos(uit)  \ 

\v2(t)  )  \  S2(t)  -  a)* a(t)  sm(uit)  ) 

and  express  equation  (21)  accordingly  as 

x(t )  =  F(x(t))u(t)  =  F(x(t))H  (x(t))v(t)  =  F{x(t))v{t)  (23) 

System  (21)  with  controls  (22)  thus  assumes  the  form 

x\  (t)  =  Vi  (t) 

X2  (t)  =  v2(t)  (24) 

£3  (t)  =  ~vi{t)x2(t) 

i.e.  it  is  of  chained  form.  It  follows  that  system  (21)  with  controls  (22)  can  be  reduced  to 

the  situation  of  Theorem  3  using  the  input  transformation  H(x)  which  is  along  with  its 
inverse  globally  defined.  The  difference  in  sign  for  x3  is  accounted  for  by  the  difference 
in  sign  in  the  definition  of  a  as  compared  with  a i  of  Theorem  3. 

□ 

The  above  result  is  an  application  of  the  concept  of  nilpotentization  since  the  input 
transformation  H (x)  is  introduced  to  make  the  distribution  spanned  by  the  control  vector 
fields  of  (21)  nilpotent.  In  [19]  we  how  show  this  approach  can  be  applied  to  other  non- 
nilpotent  matrix  Lie  groups  and  how  the  state  feedback  can  be  replaced  by  a  state 
estimate,  resulting  in  open-loop  control  laws  defining  an  approximate  inverse  for  the 
systems  considered. 

The  effect  of  the  choice  of  oj  on  the  quality  of  the  approximation  is  demonstrated  in 
Figure  3.2. 
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wO  =  10 


Figure  1:  Approximate  tracking  for  Wei-Norman  representation  of  system  on  SE(2)  with 
two  carrier  frequencies 

4  Feedback  Stabilization 

Ever  since  the  existence  of  smooth  time-invariant  feedback  laws  for  the  asymptotic  sta¬ 
bilization  of  drift-free  nonholonomic  systems  was  ruled  out  [1],  a  good  deal  of  attention 
has  been  devoted  to  proving  existence  [6]  and  constructing  [18]  time-varying,  periodic 
feedback  laws  for  these  systems.  In  these  works  the  problem  was  tackled  via  Lyapunov’s 
direct  method  and  the  approach  of  Jurdjevic  and  Quinn  [11]  was  used  to  explicitly  con¬ 
struct  time-varying  controls  and  the  corresponding  Lyapunov  function.  Following  Brock- 
ett  [2,  3]  we  take  a  different  route  in  emphasizing  the  importance  of  open-loop  steering 
for  nonholonomic  stabilization:  if  it  is  possible  to  steer  a  system  along  a  general  class 
of  trajectories  the  only  task  left  for  the  feedback  is  specifying  appropriate  trajectories 
leading  the  state  to  the  origin.  As  described  in  Section  3  composing  the  approximate 
inverse  with  the  original  system  yields  an  approximate  identity  operator,  which  can  be 
stabilized  by  standard  methods  of  robust  control,  e.g  feeding  back  the  negative  integrals 
of  the  state  to  the  approximate  inverse.  As  a  consequence  of  this  different  approach  our 
control  law  achieves  exponential  rather  than  just  uniform  stability  of  the  origin. 

The  control  law  we  present  here  is  essentially  the  same  as  in  [2,  3]  and  is  based  on 
the  approximate  inverse  of  the  Magnus  representation 
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11  =  ui 

12  =  u2 

13  =  Uiz2  -  u2zi 


of  a  system  on  H{ 3).  We  will  give  a  modified  proof  and  show  furthermore  that  the  same 
control  law  also  asymptotically  stabilizes  the  left-invariant  systems  on  SE( 2),  50(3), 
and  SL( 2)  (see  the  Appendix  for  more  information  on  these  three-dimensional  matrix 
Lie  groups). 

We  use  the  Magnus  equation  representation  of  (1)  in  this  context,  since  it  allows  us 
to  interpret  the  SE( 2),  50(3),  and  SL( 2)  systems  as  a  system  on  H{2>)  with  additional 
higher  order  perturbation  terms  (see  Example  1).  The  feedback  law  derived  for  H( 3) 
turns  out  to  be  robust  enough  to  locally  stabilize  the  perturbed  systems  as  well. 

Note  also,  that  since  the  Magnus  equation  is  globally  valid  for  the  system  on  H( 3) 
we  obtain  global  exponential  stability  for  H( 3). 

Theorem  5  Consider  the  left-invariant  drift-free  systems  on  the  three-dimensional  real 
matrix  Lie  groups  H( 3),  SE(2),  50(3),  and  SL( 2)  and  their  corresponding  Magnus 
equations 


Z  =  U+±{Z,U)  +  ±IZ,{Z,U])*--,  (25) 

where  Z  =  z\Ax  +  z2A2  +  z3 A3. 

Then  the  control  U  =  uxA\  +  u2A2  with 


u  1 


—Z\  +  \J 2uj\z3\sign(z3)  sin(o;t) 
— z2  +  \J2uj\z3\  cos(ut) 


(26) 


makes  the  zero  solution  of  the  systems  (25)  exponentially  stable  foru  sufficiently  high. 


Proof:  We  will  show  that  after  partitioning  the  state  space  and  applying  a  coordinate 
transform  the  linearizations  of  the  resulting  systems  are  exponentially  stable.  Thus,  we 
can  conclude  that  also  the  zero  solutions  of  the  original  systems  are  exponentially  stable. 
First,  note  that  with  z3  =  0  we  have  for  the  closed  loop 


[Z,U]  —  (z\u2  —  z2u\)[Ai,  A2\  +  z3u\[A3,  A\]  +  z3u2[A3,  A2] 

=  (zi\j2to\z3\  cos(uit)  -  z2\j2u\z3\ sign (^3 )  sin(a;t))[A1,  A2\ 
-\-z3U\[A3,  Ax]  -I-  z3u2 [A3,  A2] 

=  0 

such  that 
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Z  =  U,  VZ  e  So  =  {Z\z3  =  0}.  (27) 

Since  U  has  only  components  in  the  direction  of  Ax  and  A2  it  follows  that  Z  has 
no  component  in  the  direction  of  A3  for  Z  G  So  and  hence  S0  is  an  invariant  set  of  the 
closed  loop  system  (25).  Moreover,  trajectories  starting  outside  of  So  do  not  enter  S0  in 
finite  time  and  hence  we  have  a  partition  of  the  state  space  into  three  invariant  sets  So, 
Si  =  {Z\z3  >  0},  and  S2  =  {Z\z3  <  0}.  Thus,  we  can  carry  out  the  stability  analysis 
on  each  of  the  sets  separately  and  study  if  trajectories  starting  in  a  neighborhood  of  the 
origin  in  the  augmented  sets  S0,  Sx  U  {0},  and  S2  U  {0}  converge  to  it  exponentially. 

For  Z( 0)  G  S0  the  closed  loop  system  system  (25)  written  in  the  coordinates  of  the 
Lie  algebras  Q  simplifies  to 


z\  =  ~Zi 
z2  =  -z2 
i3  =  0 

and  is  clearly  exponentially  stable  on  So- 
Now,  for  Z( 0)  in  Sx  or  S2  write  (25)  as 


zx  =  -zx  +  iJ2uj\z 3I  sign  (23)  sin  (u>t )  +  px  {z ,  t) 

z2  —  -z2  +  \J2uj\z3\  cos (ut)  +  p2(z ,  t)  (28) 

i3  =  Zi\j2u>\z3\cos(ujt)  -  z2\J2u)\z3\  sign(z3)  sin(u;t)  +  p3(t,  z) 

where  px  and  p2  represent  the  contributions  of  the  second  and  higher  order  terms  on 
the  right  hand  side  of  (25),  while  p3  represents  the  contribution  of  the  third  and  higher 
order  terms  in  (25).  Define  a  coordinate  map  xx  =  zx,  x2  =  z2,  and  x3  —  sign(^3)^2|2:3|, 
which  is  a  diffeomorphism  away  from  Sq  and  apply  it  to  (28)  resulting  in 


xx  =  —  xx  +  \/ijj  x3sm(u>t)  +px(x,t) 

x2  —  -x2  +  \[u  sign(a:3)a;3  cos (vt)  +  p2(x,  t ) 

^3  =  ]:(xX\ftocos(LL)t)  —  x2y/u>sign.(x3)sm(ut))  +  p3(x,t). 

Zi 

Linearizing  (29)  at  the  origin  and  assuming  Z( 0)  G  -Si  yields 


x 


j  -1  0 

0  -1 
^  \y/u  cos(ujt)  —^y/cJsm(ujt) 
Ax(t)x, 


•v/^sin(o;t)  \ 
sfto  cos  (cut) 

0 


x 


(29) 


(30) 
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a  time- varying  system  system  with  periodic  coefficients  of  period  T  =  2ir/uj. 

By  a  standard  Floquet  argument  the  origin  of  (30)  will  be  exponentially  stable  if  the 
Floquet  multipliers,  i.e.  the  eigenvalues  of  the  transition  matrix  ^^(T,  0)  all  lie  in  the 
unit  circle.  Writing  out  the  Peano-Baker-Series  for  3%  (T,  0)  and  using  T  =  2n /uj  we 
obtain 


**(2\0)  = 


=  h  + 


+J 

fT 

1  Ai(ai)dcri  + 
n 

'•or 

^  Ai(a2)da2 

)  da  i 

(  -T 

0 

0  \ 

? 

+  n 
—  2 

0 

rp3/2  ^ 

+ 

0 

—T 

0 

+ 

0 

T  T2 

4  '  2 

0 

V  o 

0 

0/ 

0 

7^3/2 

2\/27r 

-z  ; 
2  / 

1  - 

3  T 

4 

0 

0 

\ 

+  ... 


+  o(T2) 


0 

0 


1-f  0 


+  o(T3/2). 


1- t  / 


Since  the  off-diagonal  elements  of  4%  (T,  0)  are  at  least  of  order  3/2  in  T,  also  the  radii 
Ti,  i  =  1,2,3  of  the  corresponding  Gersgorin  circles  are  of  that  order.  Thus  choosing 
T  sufficiently  small  or  u  sufficiently  large  the  r*  are  small  compared  to  the  diagonal 
elements  and  the  eigenvalues  of  4^  (T,  0)  are  therefore  guaranteed  to  be  within  the  unit 
circle.  This  proves  that  the  linearization  (30)  is  exponentially  stable  and  consequently 
also  trajectories  starting  in  a  neighborhood  of  the  origin  intersected  with  Si  converge  to 
the  origin  exponentially. 

The  argument  for  Z( 0)  in  an  intersection  of  a  neighborhood  of  the  origin  and  S2  is 
analogous  and  the  details  are  left  to  the  reader.  It  should  suffice  to  mention  that  we 
obtain 


x 


(  _1  ° 

°  _1 

\  cos(u;t)  Iv/oJsin (ut) 

A2(t)x, 


,/uisin(ujt) 

—y/ucos(ut) 

0 


\ 

x 


for  the  linearization  in  this  case,  which  differs  from  Ai{t)  only  in  a  change  of  sign  for 
two  matrix  elements.  This  leads,  as  in  the  Si  case,  to 

(  i-f  0  0  \ 

<hA2(T,0)=  0  1  -  *£■  o 


V 


0 


1-f 

0 


+  o(T3/2) 


1-f  J 


since  the  change  of  sign  in  A2{t)  affects  only  the  higher  order  terms  of  $^2(T,  0). 
Thus,  given  a  sufficiently  large  uj  there  exists  a  neighborhood  U  of  the  origin  such  that 
trajectories  starting  in  each  intersection  of  U  with  Si,  i  =  1,2,3  converge  to  the  origin 
exponentially.  This  proves  our  result. 

□ 

The  exponential  decay  of  the  states  achieved  by  the  feedback  law  above  is  shown  in 
Fig.  2  for  a  system  on  50(3). 
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Figure  2:  Feedback  stabilization  of  Magnus  equation  of  system  on  50(3)  with  u  =  1 
(left)  and  ui  =  10  (right)  and  initial  conditions  2i(0)  =  1,  z2(0)  =  -1,  23(0)  =  0.5 

5  Discussion 

We  have  presented  approximate  inversion  controls  for  left-invariant  drift-free  systems  on 
a  nilpotent  subgroup  of  the  unipotent  matrices,  which  are  equivalent  to  chained  form 
systems.  Further  we  have  derived  approximate  tracking  controls  involving  feedback  for 
a  non- nilpotent  system  on  SE(2),  outlining  a  more  general  method  for  approximated 
inversion  of  non-nilpotent  systems.  Finally  a  feedback  control  law  based  on  the  idea  of 
approximate  inversion  has  been  shown  to  exponentially  stabilize  the  origin  for  systems  on 
H( 3),  SE( 2),  50(3),  and  SL( 2).  These  solutions  for  specific  matrix  Lie  groups  should 
serve  as  examples  to  point  out  the  significance  of  the  approximate  inversion  approach  to 
open-loop  tracking  and  feedback  stabilization  of  nonholonomic  systems. 

We  plan  to  generalize  these  results,  heading  toward  a  method  to  construct  an  approx¬ 
imate  inverse  for  a  system  on  a  matrix  Lie  group  based  solely  on  the  structure  of  the  Lie 
algebra  and  the  nature  and  number  of  the  inputs.  Numerical  solutions  might  have  to  be 
taken  into  account  where  closed  form  results  are  not  available. 

A  rigorous  characterization  of  the  approximate  inverse  together  with  the  original 
system  as  a  time-varying  perturbation  of  an  identity  operator  needs  to  be  developed 
for  a  more  unified  approach  to  feedback  stabilization  of  nonholonomic  systems.  Robust 
stability  methods  could  then  be  applied  drawing  only  on  the  characterization  of  the  ap¬ 
proximate  identity  operator  rather  than  the  properties  of  the  original  system.  Eventually 
we  would  like  to  extend  our  results  to  nonholonomic  systems  with  drift. 
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Appendix 

A  Three-dimensional  Matrix  Lie  Groups 

For  reference  we  present  here  a  canonical  list  of  non- Abelian  three-dimensional  matrix  Lie 
groups  and  Lie  algebras,  which  are  characterized  by  a  choice  of  bases  Ai,  A2,  A3  of  their 
Lie  algebras  satisfying  [Ai,  A2]  =  aA3,  This  list  “nearly”  represents  a  complete 

classification  of  non- Abelian  three-dimensional  Lie  algebras  neglecting  only  the  solvable 
Lie  algebras  not  isomorphic  to  se( 2)  (for  a  complete  classification  see  for  example  [21]). 
Our  focus  on  three-dimensional  real  Lie  groups  is  motivated  by  their  simple  structure 
and  their  immediate  relevance  for  applications  in  mechanics  and  nonholonomic  motion 
planning  which  holds  especially  for  SE( 2)  and  50(3). 

Let  H( 3)  denote  the  Heisenberg  group  of  real  3x3  upper  triangular  matrices  and  fix 
a  basis  for  the  corresponding  Lie  algebra  h( 3) 


0  1  0  \ 

0 

0 

0 

(  0  0  1  \ 

0  0  0 

,  a2  =  0  0  1 

)  M  — 

0  0  0 

0 

0 

0 

V  0  0  0  j 

0 

0 

0 

yielding  the  following  bracket  structure: 


[^1,^2]  =  A3,  [Ai,A3]  —  0,  [A2,  A3]  —  0. 


Let  SE(2)  denote  the  Special  Euclidean  group  representing  rigid  motions  in  the  plane 
and  fix  a  basis  for  the  corresponding  Lie  algebra  se(2) 


/  0 

-1 

0  V 

(0 

0 

f  0 

0 

°\ 

1 

0 

0 

>  a2  — 

0 

0 

0 

,  a3  — 

0 

0 

1 

\o 

0 

0  J 

[0 

0 

0 ) 

^0 

0 

oy 

yielding  the  following  bracket  structure: 


[Ai,  A2]  —  A3,  [Ai,A3]  —  —  A2,  [A2,A3]  —  0. 


Let  50(3)  denote  the  Special  Orthogonal  group  representing  rotations  in  three- 
dimensional  Euclidean  space  and  fix  a  basis  for  the  corresponding  Lie  algebra  so(3) 


1 

f  0  0  0  \ 

/  0  0  IN 

(0  -1  0\ 

II 

0  0-1 

,  a2  =  0  0  0 

,  a3  =  1  0  0 

1 

ill  oj 

1-1  0  oj 

0 

0 

0 

yielding  the  following  bracket  structure: 


[Ai, A2]  —  A3,  [Ai , A3]  —  —  A2,  [A2, A3]  —  A\. 


Let  SL{ 2)  denote  the  Special  Linear  group  of  2  x  2  matrices  with  determinant  one 
and  fix  a  basis  for  the  corresponding  Lie  algebra  sl{ 2) 
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yielding  the  following  bracket  structure: 


[Ai,  A2\  —  2A3,  [Ai,  A3]  —  —  Ai,  [A2,A3]  —  A2. 


The  following  table  summarizes  some  properties  of  the  listed  matrix  Lie  groups. 


H( 3) 

SE(  2) 

50(3) 

SL(  2) 

nilpotent 

solvable 

simple 

simple 

not  compact 

not  compact 

compact 

not  compact 

connected 

connected 

connected 

connected 
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